
Base_Position target_position
CartesianTrajectoryConstraint constraint